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ЧИНЬ СУАН ЛОНГ 


ИНТЕЛЛЕКТУАЛЬНАЯ СИСТЕМА УПРАВЛЕНИЯ МОБИЛЬНЫМ 
РОБОТОМ НА ОСНОВЕ ЭЛЕКТРОННОГО КОМПАСА 


Компас является популярным инструментом при навигации. В прошлом компасы 
использовались для определения координат судов в море и местонахождения 
людей в лесу. Сегодня с развитием техники электронные компасы помогают 
принимать решения не только в навигации, но и для перемещения мобильных 
роботов. Электронный компас помогает определить правильное направление точки 
цели, рассчитать погрешности направления и улучшить результат управления 
роботом. 
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Введение. Имеется много методов навигации мобильными роботами, и 
одним из них является электронный компас. Электронный компас, 
имеющий множество преимуществ (компактные размеры, высокая 
разрешающая — способность, легкость в применении и высокая 
эффективность), является оптимальным решением в определении угла 
точки цели. Задав правильный угол цели системе управления робота, 
электронный компас наряду с другими датчиками, такими как 
дешифраторы, ультразвуковые, инфракрасные сенсоры, помогает улучшить 
результаты управления. В данной работе предлагается использование 
электронного компаса для управления мобильным роботом, чтобы 
сократить число ошибок. Этот метод имеет более высокую эффективность, 
и процесс управления становится проще. 

Преимущества использования электронного компаса в мобильном 
роботе. Мобильный робот движется в неопределенной среде, в которой 
число, размер, форма и положение препятствий неизвестны. Робот должен 
пройти от стартовой точки до конечной, не сталкиваясь с препятствиями. 
Робот имеет 10 ультразвуковых датчиков, расположенных на корпусе, два 
электродвигателя с двумя интегрированными датчиками частоты вращения 
(епсоаег) и коробкой передач, электронный компас, батареи, контроллер, 
как показано на рис.1. 
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Рис.1. Устройство мобильного робота 
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В статье описано использование электронного компаса СМР$03З 
производства компании «Оеуамщесй» [1]. Этот компасный модуль был 
специально спроектирован как вспомогательный прибор для управления 
перемещением робота (рис.2). Цель проекта — получить однозначное 
значение параметра управления для представления направления 
перемещения, при котором предстоит выполнить роботу. Компас 
использует датчик с магнитным полем, который достаточно чувствителен, 
чтобы определить магнитное поле Земли. 

Перед применением электронного компаса необходимо 
спроектировать материнскую плату (электронную цепь) для связи компаса 
с источником энергии и передачи сигнала системе управления мобильного 
робота (рис.3). После этого следует установить и настроить компас по 
направлению магнитного поля Земли. Для робота спроектирована 
материнская плата, включающая контроллер и присоединительные точки 
(контакты) для дешифраторов, ультразвуковых датчиков и электронного 
компаса. На роботе установлен компьютер, который имеет программу для 
отражения работы робота на дисплее. 
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Рис.3. Место электронного компаса СМР$03 
на материнской плате 


Математическое и программное обеспечение системы управления 
мобильным роботом. Действительно, этот робот может двигаться к 
позиции цели с ультразвуковыми датчиками и двумя датчиками частоты 
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вращения, следуя методу одометрии. В этом методе координаты 
мобильного робота определяются путем применения основных 
геометрических отношений планиметрии (геометрии плоскости). Это 
необходимо для определения координат робота на плоскости ХУ. 

Предположив, что положением п-й координаты робота является 
(х,, У"), а угол направленности относительно оси \ - 9 „, рассчитываем 
координаты робота в (п+1)-й позиции (время между п-й и (п+1)й -— 
постоянная величина, например, 10 т5). 

Движение левого колеса выражено как р (тт) на рис. 4, а правого 
колеса — а (тт). Эти оба движения определяются датчиками частоты 
вращения. Соответственно расстояние робота от п-й до (п+Г)-й 
координаты можно выразить как 

= (р+4а)/2. 

Угол погрешности робота при движении от п-й до (п+1)-й 
координаты очень мал, следовательно, можно ввести формулу отклонения 
угла: 

Ад ЛО = (р-9)/4. 
Угол направления при (п+1)/п 

0 „., = О9.+ 40. 
Координаты робота при (п+1): 

Хи+1 = Хи + а.5т @ п+1, 

Уп+1 = Ул + 49.505 @ пла. 





Рис.4. Расчет координат угла погрешности 


Мы можем определить координаты мобильного робота при помощи 
лишь двух датчиков частоты вращения. 

Основной идеей одометрии является интеграция информации 
дифференциального (инкрементного) движения во времени, что 
неизбежно ведет к накоплению ошибок. В частности, накопление ошибок 
определения ориентации вызовет большие позиционные погрешности, 
которые увеличиваются пропорционально расстоянию, пройденному 
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роботом. Несмотря на это, одометрия является важной частью системы 
перемещения робота и может быть упрощена, если можно улучшить 
точность одометрии. 

С электронным компасом вычисление становится проще и нет 
накопления ошибок ориентации, так как величина @ „„, является 
абсолютной. Нам нужно только настроить разрешающую способность 
электронного робота соответственно конкретному случаю. 





Рис.5. Определение угла до цели 


Текущий угол определяется при помощи электронного компаса. Это 
полезная функция при движении к точке цели. Например, в данный момент 
робот находится в точке (х:, у!), и нужно двигаться к точке (х», у2), как 
показано на рис. 5. Благодаря электронному компасу определен угол @ 
Затем вычисляется угол @ между (хи, у!) и (х», у2): 

( = агс(х› — х!)/( у? — у1). 

Роботу нужно развернуться на угол @ - @ и затем идти прямо к 
точке (х›, у?). Чтобы управлять движением робота при наличии 
препятствий без столкновений, используются методы обхождения 
препятствий. Затем, после избежания столкновения, робот получит новую 
координату и новый угол направления движения. Вышеуказанное 
вычисление повторяется для определения направления движения робота. 

Для обхождения препятствий используются нечеткая логика и 
нейронная сеть [2-4]. При помощи нейронной сети классифицируют 
окружающую среду на несколько более простых ситуационных классов. 
Затем, используя нечеткую логику, принимают решения о движении 
мобильного робота при помощи базы правил, которая построена и связана 
с каждой ситуацией (рис.6). 

Робот изменяет направление к цели в процессе движения и 
приходит к цели безопасно (рис./7). 
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Рис.6. Структура обхождения препятствия 
и схема контроллера поиска цели 
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Рис.7. Результаты движения мобильного робота 
отражены на экране компьютера 


Заключение. С помощью электронного компаса СМР$0З проблема 
обхождения препятствий и движения мобильного робота решена с высокой 
эффективностью определения угла направления и угла отклонения. 
Точность определения углов до 0.5° зависит от разрешающей способности 
электронного компаса СМР503. Кроме этого, электронный компас 
уменьшает накопленные ошибки угла при перемещении. 
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ТЕТМН ХЧАМ ОМС 
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